#include "DoubleVictor.h"

namespace Team675
{

DoubleVictor::DoubleVictor(UINT8 _module1, UINT32 _channel1, UINT8 _module2, UINT32 _channel2)
{
	m_vick1 = new Victor(_module1, _channel1);
	m_vick2 = new Victor(_module2, _channel2);
}

void DoubleVictor::Set(float _speed, UINT8 syncGroup)
{
	m_vick1->Set(_speed);
	m_vick2->Set(_speed);
}

float DoubleVictor::Get()
{
	return m_vick1->Get();
}

void DoubleVictor::Disable()
{
	m_vick1->SetRaw(0);
	m_vick2->SetRaw(0);
}

void DoubleVictor::PIDWrite(float output)
{
	Set(output);
}

}
